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ABSTRACT 


The  angular  momentum  of  a  free- flying  multibody  system  in 
space  is  a  conserved  gueuitity.  This  conservation  law  acts  as  a 
nonholonomic  constraint  and  manifests  itself  when  cyclic  motion  of 
the  articulated  joints  of  an  on  board  manipulator  produces  a  net 
change  in  the  orientation  of  the  whole  system.  This  poses  two 
important  and  coupled  problems:  (a)  the  motion  planning  problem  of 
the  manipulator  for  attitude  reorientation  of  the  space  structure 
using  internal  motion  of  the  joints,  cmd  (b)  planning  the 
manipulator  joint  trajectories  that  produce  repeatable  motion  of 
all  the  configuration  variables.  We  have  adopted  a  surface 
integral  approach  to  come  up  with  algorithms  for  these  nonholonomic 
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I .  INTRODUCTION 


There  is  a  growing  interest  in  the  area  of  attitude 
control  and  motion  planning  of  multi -body  systems  in  space. 
These  structures  in  space  are  expected  to  have  attached 
articulated  joint  manipulator  arms  on  board.  A  problem 
arises  for  these  structures  in  that  the  movement  of  the 
manipulator  arm  will  cause  a  displacement  for  the  whole 
structure.  This  displacement  is  a  result  of  the  dynamic 
coupling  between  the  arm  and  the  structure.  Multi-body 
systems  in  space,  in  the  edjsence  of  external  forces,  conserve 
the  angular  momentum  of  the  system.  This  conservation  acts  as 
a  nonholonomic  constraint  on  the  motion  of  the  system.  For 
structures  with  attached  manipulator  arms,  this  conservation 
law  manifests  itself  when  cyclic  motion  of  the  manipulator 
joints  produce  a  net  change  in  the  orientation,  i.e.,  a  drift 
in  the  orientation,  of  the  whole  system.  Changes  in  system 
orientation  can  also  arise  from  other  causes  such  as:  (l) 
differential  gravitational  forces;  (2)  solar  radiation 
effects;  (3)  dynamic  interactions  between  a  space  station  and 
on  board  robots  or  a  docking  shuttle  craft;  and,  (4)  the 
operation  of  booster  rockets  used  for  orbit  maintenance  [Ref. 
201  . 
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An  extensive  literature  survey  will  lead  one  to  believe 
that  the  best  way  for  attitude  control  would  be  to  use 
momentxiin  exchange  devices  with  control  momentum  gyroscopes  as 
the  most  desirable  devices  for  attitude  control. 

Though  the  most  desirable  devices,  gyroscopes  have  some 
disadvantages  which  are:  (l)  they  require  a  steady  power 
source  to  overcome  the  dissipated  energy  of  the  friction  in 
the  bearings;  (2)  susceptibility  to  mechanical  failure  as  a 
result  of  its  constant  motion;  and,  (3)  a  significant  added 
weight  effect.  Other  devices  such  as  booster  rockets  and  gas 
jets  have  the  disadvantage  of:  (l)  requiring  onboard  fuel 
storage  which  adds  a  considerable  weight  effect;  and,  (2)  fuel 
sources  that  once  eaqiended  are  non-replenishable  without  a 
consideraJale  monetary  expense. 

If  manipulators  can  effectively  be  used  to  reorient  a 
space  structure,  they  Ccui  serve  as  a  reliable  back-up  means  of 
attitude  control  in  the  event  of  a  power  interruption  or 
mechanical  failure  of  the  gyroscope.  In  the  case  of  a  small 
satellite  with  an  attached  manipulator  where  the  added  mass  of 
a  gyroscope  or  booster  rocket  fuel  is  undesirable,  the 
manipulator  can  serve  the  dual  purpose  of  attitude  control  and 
automation  in  space. 

The  advantages  of  the  manipulator  are:  (1)  they  are 
already  aboard;  (2)  require  much  less  power  than  momentum 
exchange  devices;  (3)  are  less  susceptible  to  mechanical 
failure;  and,  (4)  use  of  the  manipulators  internal  controls 
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does  not  modify  the  total  angular  momentum  of  the  system  [Ref . 
24]  . 

A  related  issue  to  using  a  manipulator  arm  to  reorient  a 
space  structure  is  that,  due  to  the  nonholonomic  nature  of  the 
structure,  the  use  of  a  manipulator  to  perform  a  required  task 
may  result  in  a  undesiraJale  change  in  the  orientation  of  the 
structure.  It  thus  becomes  desirable  to  be  able  to  predict 
and  control  the  change  in  orientation  of  a  freely- floating 
space  structure.  The  ability  to  predict  and  control  this 
change  is  the  subject  of  this  thesis. 

Some  of  the  earliest  work  in  the  study  of  the  motion 
planning  problems  of  nonholonomic  systems  has  been  done  by 
Kane  and  Scher  [Ref.  12]  ,  who  studied  the  falling  cat  problem, 
and  Kane,  Hedrick  and  Yatteau  [Ref.  11],  who  studied  the 
astronaut  maneuvering  scheme. 

More  recently  the  study  of  the  use  of  manipulators  for 
reorientation  of  space  structures  has  been  done  by  Vafa  and 
Dubowsky  [Ref.  29]  ,  where  cyclic  motion  of  the  joint  variables 
were  proposed  to  reorient  the  space  vehicle,  and  Fernandes, 
Gurvits  and  Li  [Ref.  4]  proved  the  controllability  of  a  space 
robot  system  using  a  three  link  manipulator.  This  work 
motivated  Nakamura  and  Mukherjee  [Ref.  22]  ,  who  proposed  a  bi¬ 
directional  approach  to  the  motion  planning  of  free- flying 
space  robots  to  control  both  the  space  vehicle  orientation  and 
the  manipulator  joints  by  actuating  only  the  manipulator 
joints.  Conversely,  Yeunada  and  Yoshikawa  [Ref.  32]  prescribed 
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an  arm  trajectory  and  then  found  the  optimal  trajectory  that 
yielded  the  desired  attitude  change  with  the  minimum  arm 
movement.  Walsh  and  Sastry  [Ref.  31]  provided  kinematic 
algorithms  for  reorienting  some  systems  of  linked  rigid  bodies 
floating  in  space. 

Other  studies  on  the  control,  stabilization, 
repeatability,  drift  and  motion  planning  for  reorientation  of 
linked  multi-bodied  stoructures  in  space  can  be  found  in  the 
reference  section. 

This  thesis  follows  on  with  work  done  by  Mukherjee  and 
Anderson  [Ref.  19]  ,  wherein  they  proposed  a  method  of  the 
surface  integral  approach  for  planning  the  motion  of  a  two 
dimensional  nonholonomic  system. 

In  this  thesis  we  present  two  concepts.  The  first  is  an 
algorithm  for  the  motion  planning  of  a  space  manipulator  to 
achieve  attitude  control  of  a  freely- floating  three 
dimensional  space  structure.  Generally  stated  the  algorithm 
provides  a  means  for  calculating  the  coordinate  trajectories 
required  to  drive  a  nonholonomic  system  from  one  point  in  its 
configuration  space  to  some  other  desired  point.  The 
algorithm  invokes  the  use  of  Stokes'  Theorem  and,  therefore, 
takes  a  surface  integral  approach  to  the  problem  as  is  done  in 
[Ref.  20]  . 

Secondly,  we  present  a  means  of  determining  the 
manipulator  motion  required  for  the  nonholonomic  freely 
floating  space  structure  to  behave  in  a  holonomic  manner 
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globally,  which  we  call  "pseudo- hoi onomic  behavior"  [Ref.  21]  . 
The  method  determines  if  "holonomic  loops"  [Ref.  21]  do  exist, 
where  the  system  exhibits  holonomic  behavior  globally  for 
particular  paths  in  the  configuration  space  of  the 
nonholonomic  system.  The  planar  space  robot  is  the  system 
studied  and  its  configuration  space  is  the  joint  space  of  the 
manipulator.  If  a  "holonomic  loop"  does  exist,  wc  present  an 
algorithm  for  finding  that  loop  within  the  configuration 
space . 

This  thesis  is  organized  as  follows: 

Chapter  II  presents  some  mathematical  preliminaries 
necessary  for  understanding  the  behavior  of  nonholonomic 
systems. 

Chapter  III  studies  the  freely  floating  three  dimensional 
space  structure  with  an  attached  three  link  manipulator  as 
shown  in  Figure  1.1.  The  problem  to  be  solved  is  to  change 
the  orientation  of  the  structure  from  one  configuration  to 
another  configuration  by  moving  the  manipulator  arm  joints 
along  pre-planned  paths.  An  example  of  the  initial  and  final 
orientations  of  the  structure  are  as  shown  in  Figure  1.2. 
Chapter  III  provides  an  algorithm  for  planning  the  path  of  the 
manipulator  joints  necessary  to  achieve  a  desired  change  in 
orientation  of  the  structure.  Once  the  path  is  planned  a 
simulation  is  conducted  to  illustrate  that  manipulators  can 
indeed  reorient  a  space  structure. 
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Chapter  IV  studies  the  freely- floating  planar  space  robot 
with  an  attached  two  link  manipulator  arm  as  shown  in  Figure 
1.3.  The  problem  to  be  solved  is  how  to  plan  the  path  of  the 
manipulator  arm  joints  such  that  the  space  robot  will  not 
reorient  itself  in  space.  This  amounts  to  finding  the  path  in 
space  for  the  manipulator  arm  where  the  planar  space  robot 
exhibits  holonomic  behavior  globally.  Chapter  IV  provides  an 
algorithm  for  planning  the  path  of  the  manipulator  joints  that 
will  allow  the  planar  space  robot  to  regain  its  original 
orientation  after  the  manipulator  motion  is  complete.  Once 
the  path  is  planned  a  simulation  is  conducted,  illustrating 
that  repeatable  motion  is  possible  for  nonholonomic  systems. 

Chapter  V  presents  conclusions  and  recommendations. 
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Figure  1.1 


A  Freely- Floating  Space  Structure  with  a  3 
Link  Manipulator. 
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Space  Vehicle 


Figure  1.3  A  Planar  Space  Robot  With  Two  Links 
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II.  MXTHSIUITICAL  PRBLIMIIIARIES 


A.  RELEVANT  THEOREMS 

A  review  of  a  few  mathematical  theorems  is  necessary  to 
understeuid  how  nonholonomic  systems  behave  and  the  problem 
solutions  which  we  propose.  The  first  theorem  concerns  the 
exactness  euid  integred)ility  of  a  differential  equation.  The 
second  concerns  the  path  independence  of  line  integrals. 
Finally,  the  third  is  Stoke' s  Theorem,  which  transforms  line 
integrals  into  surface  integrals. 

1.  Theorem  1:  Exactness  [Ref.  5] 

A  differential  expression  of  the  form 

M{x,  y,z)dx  *  Nix,  y,  z)  dy  +  Pix,  y,  z)dz  #*> .  1 1 


is  exact  on  a  dcnnain  D  in  space  if. 


Mdx  +  Ndy  +  Pdz 


^dx 

ax 


df 


(2-2) 


for  some  (scalar)  function  f  throughout  D.  The  differential 
form  Equation  (2-1)  is  exact,  if  and  only  if; 


dP^dN  dM  ^  dP  dN  _  ^ 

■5^  ai  '  dy  ' 


(2-3) 
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It  is  a  well  established  fact  that  a  differential 
expression  is  integrable,  if  it  is  exact  or  can  be  made  exact, 
by  multiplying  it  by  an  integrating  factor.  In  other  words, 
exactness  iir^lies  integradjility.  Therefore,  it  follows  that 
non-integreLbility  inplies  non- exactness.  Exactness  is  also  a 
necessary  and  sufficient  condition  for  path  independence  of 
line  integrals.  This  is  stated  formally  next. 

2 .  Theorem  2 1  Exactness  and  Independence  of  Path 

[Ref.  14] 

Let  f(x,y,z),  g{x,y,2)  euid  h(x,y,z)  be  continuous 

functions  in  a  domain  D  in  space,  then  the  line  integral  is 

+  gdy  +  hdz)  (2-4) 

is  independent  of  the  path  C  in  D,  if  and  only  if,  the 
differential  form  under  the  integral  sign  in  Equation  (2-4)  is 
exact  in  D.  Additionally  the  line  integral  is  independent  of 
path  in  D  if  and  only  if  it  is  zero  on  every  simple  closed 
path  C  in  D. 

A  line  integral  over  a  closed  path  C  can  be  converted 
the  into  a  surface  integral  utilizing  the  well  known  Stoke 's 
Theorem  [Ref.  2] . 

3.  Theorem  3:  Stoke' s  Theorem  [Ref.  2] 

If  D  is  a  k-dimensional  space  and  w  is  a  (k-l) 
differential  form  on  D,  then  from  Stoke 's  theorem  we  have 


11 


f  (a  -  f  d<ji 

Jao  Jd 


(2-5) 


where,  9D  is  the  path  of  the  line  integration  and  is  the 
boundary  of  the  domain  D,  and  dw  is  a  differential  k  form, 
obtained  by  the  exterior  differentiation  of  w. 

B.  MBNIFESTATIQN  OF  1I0MH0L0NGM7 

The  is^ortance  of  theorem  2  lies  in  the  fact  that 
nonholonomic  systems  are  governed  by  non-integredsle  and,  hence 
non-exact  differential  constraint  equations.  Nonholonomic 
systems  are,  therefore,  path  dependent.  To  illustrate  path 
dependency  consider  the  following  ecpiatlon: 

dp  =  v^dx  *  v^dy  +  v^dz  (2-6) 

Where:  .(1)  p  is  the  dependent  varicdble  of  a  nonholonomic 
system;  (2)  x,  y  emd  z  are  the  independent  variables;  and,  (3) 
V2  euid  V3  are  continuous  fxmctions  of  x,  y  cuid  z.  Since 
the  system  is  non-integrcd)le  the  differential  form, 

Vj^dx  +  Vjdy  +  V3dz 

is  not  exact.  Therefore,  by  theorem  2  the  change  in  p  is  path 
dependent.  Hence,  it  is  possible  to  change  the  coordinates  of 
the  dependent  variable  p,  by  using  closed  trajectories  of  the 
independent  variables,  as  shown  in  Figure  (2.1).  The 
independent  variad>les,  which  trace  the  closed  path  C,  start  at 
point  two,  move  around  the  path  amd  return  to  point  five. 
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coincident  with  point  two.  The  independent  variables  have 
returned  to  their  original  value,  whereas  the  dependent 
variable  p  has  taken  on  a  new  value,  p  +  Ap.  Path  dependency 
is  a  characteristic  of  nonholonomic  systems,  which  we  will  use 
to  reorient  a  structure  in  space  using  angular  momentvim 
preserving  controls;  this  is  considered  next. 

C.  THE  SURFACE  INTEGRAL  APPROACH:  ATTITUDE  CONTROL 

In  Chapter  I,  we  have  seen  that  freely  floating  structures 
in  space  are  nonholonomic  systems.  The  nonholonomy  arises 
from  the  fact  that  the  conservation  of  angular  momentvim  yields 
non-integrcd>le  constraints  of  motion.  It  is  this  non- 
integrsdaility  that  permits  the  reorientation  of  the  structure 
while  maintaining  a  zero  value  of  angular  momentum. 

In  the  case  of  an  articulated  space  structure,  the 
nonholonomic  constraint  equations  relate  the  rate  of  change  of 
the  dependent  variables,  the  structure  orientation,  to  the 
rate  of  change  of  the  independent  variables,  the  angles  of  the 
articulated  arms.  To  achieve  the  desired  change  in  the 
orientation  of  the  structure,  we  need  only  find  the  correct 
path  in  the  configuration  space  of  the  independent  variables, 
the  joint  angles,  to  yield  the  desired  change  in  the  dependent 
variables,  the  orientation  of  the  structure.  We  can  find  this 
path  by  methodically  utilizing  the  surface  integral  approach 
to  solve  for  the  closed  path. 
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The  nonholonomic  motion  constraint  equation  for  the 
articulated  structure  can  be  expressed  in  a  differential  form. 
Integration  of  this  differential  form,  to  obtain  the  change  in 
the  dependent  variable,  amounts  to  solving  the  line  integral 
of  the  equation  in  the  space  of  the  dependent  varicJales.  The 
surface  integral  approach  utilizes  Stoke' s  theorem  to  convert 
the  line  integral  into  a  surface  integral.  This  approach 
sin^lifies  the  mathematics  and  allows  us  to  appropriately 
choose  a  surface  area,  which  will  yield  the  desired  change  in 
the  dependent  variod)le.  Once  the  surface  area  is  chosen,  the 
path  enclosing  the  surface  area  can  be  fo\and  by  setting  the 
limits  of  integration.  The  change  in  the  dependent  variables 
can  now  be  found  as  a  function  of  the  limits  of  integration. 
By  choosing  the  limits  of  integration,  we  have  the  ability  to 
satisfy  additional  constraints,  such  as  the  limits  on  the 
values  of  the  independent  variables. 

To  illustrate  this,  consider  an  arbitrary  space  structure 
as  previously  shown  in  Figure  1.1  with  an  attached  manipulator 
arm.  Suppose  that  the  manipulator  has  constraints  on  its 
motion,  such  as  joint  limits  or  work  space  limitations.  Now 
suppose  we  wish  to  reorient  the  structure  by  an  amount  where 
0  *  nk,  where  n  =  1,2,  ... ,  euid  k  is  the  change  in  orientation, 
as  the  manipulator  traverses  a  path  c.  By  appropriately 
setting  the  limits  of  integration,  we  can  choose  our  surface 
such  that  we  reorient  the  structure  by  traversing  a  path  C  one 
time  or  traversing  a  smaller  path  c,  n  times.  The  manipulator 
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motion  can  then  be  planned  amidst  additional  constraints, 
such  as  manipulator  joint  limits  and  environmental  work  space 
limitations.  The  surface  integral  approach  will  be  presented 
in  detail  in  Chapter  III. 

D.  THB  NECESSARY  CONDITION  FOR  REPEATABILITY 

The  property  of  repeatability  of  a  system  is  that,  when 
the  independent  variadiles  move  along  closed  trajectories,  the 
dependent  variables  also  move  along  closed  trajectories. 
Repeatability  is  ensured  if  the  differential  constraints  of 
motion  of  a  system  are  integrable  and,  hence,  are  path 
independent.  Naturally  holonomic  systems  exhibit  this 
property. 

The  purpose  of  Chapter  IV  is  to  demonstrate  that:  (1) 
integraibility  of  the  differential  constraint  is  only  a 
sufficient  condition  for  repeatability,  but  it  is  by  no  means 
a  necessary  condition;  and,  (2)  that  a  necessary  condition  for 
the  repeatable  motion  of  a  nonholonomic  system  is  as  follows: 

Consider  a  two  dimensional  path  dependent  system  where  6q 
is  the  dependent  variedjle  and  and  B2  are  the  independent 
variables-  Suppose  also  that  the  dependency  of  on  B^  and 
B2  is  explicitly  given  by  the  following  equation: 

d^o  *  +  92^^ 2  <2-7) 


15 


where  and  93  are  functions  of  6^  and  ^2*  change  in  the 

dependent  variable  is  given  by  the  line  integral. 


/c«o  =  / 


-  d8,Ad6j 

OO2 

-  -^1  (d0iAdB2)-o 


(2-8) 


applying  Stokes'  theorem  yields. 


(2-9) 


where  "A"  denotes  the  exterior  product,  denotes  the  dot 
product  and  <x,  the  orientation  of  D  has  the  same  orientation 
as  cbC2AdX2  when  the  direction  along  the  path  is 
counterclockwise,  otheirwise  a  has  the  same  orientation  as 
dx^dx^.  For  a  nonholonomic  system, 

301  302 


hence,  we  define 


(■&  -  -S)  *  F(6i,e,) 


(2-10) 
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substituting  into  Equation  (2-9)  we  get 


r  dBo  *  f  F(ei,e2)dBiC»2 

JdD  J  D 

=  f(0l-,02‘)/^d0iC©2 

=  F(0i*,02*)l5(i?)  ,  (0i’,02*)€Z? 

Equation  (2-10)  was  obtained  by  the  application  of  the  meeui 
value  theorem  of  integral  calculus.  The  function  F  Ceui  be 
shown  to  be  continuous  in  the  entire  domain  D  euid,  hence,  the 
mecm  value  theorem  applies.  6j*  euid  $2*  denote  some  point 
within  the  domain  D;  eind,  ir(D)  is  the  measure  of  the  domain  D; 
In  this  case  it  is  sinqply  equal  to  the  area  enclosed  within 
the  closed  curve  dD.  Fi6^*,02*)  can  also  be  interpreted  as  the 
rneam  value  of  the  function  F,  defined  by  Equation  (2-10), 
teUcen  over  the  domain  D.  If  this  meam  value  happens  to  be 
zero,  then  we  would  have  no  net  change  in  the  dependent 
variable  as  the  independent  variables  move  along  closed  paths 
and  return  to  their  original  value.  Hence,  we  have  a 
nonholoncxnic  system  that  exhibits  pseudo  holonomic  behavior. 
We  will  apply  this  concept  to  a  planar  space  robot  in  Chapter 
IV. 
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(1) =  (xfyfzfpQ) 

(2)  *  (XQ,  yo.  zq,  Po+  5p) 

(5) =  (xo^yo.zo’Po-^P  +  ^P) 

(6) *  (xfyfzfpp  +  Ap) 


I 


Figure  2.1: 


The  Closed  Trajectory  C  in  the  Independent 
Variables  X,  Y,  and  Z  Produces  a  Change  in 
the  Dependent  VarieUsle  P  by  em  Amoxint  dp. 


Ill'/  THE  SURFACE  INTEGRAL  APPROACH:  ATTITUDE  CONTROL 


A.  INTRODUCTION  AND  NOMENCLATURE 

In  Chapter  I,  we  saw  that  for  a  freely- floating  space 
structure  with  an  attached  manipulator  arm  that  if  the 
manipulator  can  effectively  be  used  to  reorient  the  structure 
then  manipulators  can  serve:  (1)  as  a  reliable  back-up  to 
gyroscopes;  and,  (2)  the  dual  purpose  of  attitude  control  and 
automation  in  space. 

In  this  chapter,  we  develop  the  algorithm  for  attitude 
control  of  a  space  structure  using  a  three  link  manipulator 
and  present  the  results  of  the  simulations.  We  assume  the 
robot  to  have  a  PUMA  type  structure  as  shown  in  Figure  3.1(a)  , 
euad  the  reference  frames  are  according  to  the  Denavit- 
Hartenburg  [Ref.  3]  convention.  Figure  3.1(b)  shows  the 
kinematic  structure  of  the  manipulator.  For  mathematical 
sin^licity:  (1)  the  center  of  mass  of  the  system  was  chosen  to 
coincide  with  the  geometric  center  of  the  body;  and,  (2)  the 
inertial  and  body  fixed  axes  were  ''•hosen  to  be  coincident  at 
point  S. 

The  following  nomenclature  is  used  throughout  the 
development : 

frame  J  Inertia  frame. 
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frame  S 


Frame  fixed  at  the  center  of  mass  of  the 
space  structure  and  directed  along  the 
principal  axes  of  the  structure. 

frame  K  The  Jc-th  kink  frame  of  the  manipulator 

according  to  the  Denavit-Hartenburg  [3] 
convention,  k  *  0  denotes  the  manipulator 
base  frame. 

ni]^  Mass  of  the  k-th  body  for  k  =  1,  2,  3... 

the  mass  of  the  space  structure  is  (kg) . 

Inertial  matrix  of  the  k-th  body  about  the 
principal  axes  located  at  the  center  of 
mass,  and  expressed  in  the  k-th  link 
frame.  The  inertia  matrix  of  the  space 
structure  is  denoted  by  ®Ig,  (kgjiP) . 

(i,j )-th  element  of  (kga^)  . 

^otYot^o  Position  of  the  center  of  mass  of  the 

space  structure  in  the  inertia  frame  (m) . 

01 » 02 '^3  y-x-y  Euler  angles,  describing  the 

orientation  of  the  space  structure  with 
respect  to  the  inertia  frame. 

/Sq , , /S2 / i®3  Euler  parameters  [Ref.  10]  . 

R[*,*]  €  R^*^  Orthogonal  rotation  matrix  corresponding 

to  a  rotation  of  the  (•)  axis  fixed  on  the 
space  structure  by  an  angle  (*) . 

Joint  configuration  of  the  three  link 
manipulator. 

B.  ALGORITHM  FOR  MOTION  PLANNING 

The  cuigles  and  parcuneters  of  interest  in  the  development 
of  the  algorithm  for  motion  planning  are:  (1)  Euler  angles, 
describing  the  orientation  of  the  space  structure;  (2)  Euler 
parameters;  and,  (3)  the  joint  angles  of  the  manipulator.  The 
"home"  euid  "intermediate"  configurations  of  the  manipulator 
are  as  shown  in  Figure  3.2.  The  "home"  configuration  is 


20 


defined  as  6^,  $2.  and  $2  equal  to  zero  degrees  where  6^,  $2, 
and  $2  are  the  joint  angles  of  the  first,  second,  and  third 
links,  respectively.  The  "intermediate"  configuration  is 
defined  as  6-^  equal  to  ninety  degrees  and  $2  and  ^3  equal  to 
zero  degrees. 

The  reorientation  of  the  space  structure  will  be  achieved 
through  rotations  of  the  structure  about  the  body  fixed  x,  y, 
and  z  axes.  Our  goal  is  to  change  the  orientation  of  the 
space  structure  from  an  initial  set  of  Euler  angles  4)^^,  4>2i.' 
<l>2i  to  a  desired  set  of  values  <t>2f,  <l>2f  without  any  change 
in  the  system  configuration.  In  other  words,  we  would  like 
the  manipulator  to  have  the  same  joint  configuration  {6^,  62, 
d3),say  the  "home"  configuration,  when  the  orientation  of  the 
structure  is  (<(>i . <f>2 , <(>3)  ■  •  Th® 
initial  and  final  configurations  are  given  in  Figure  3.3. 
Three  classes  of  motion  are  defined  as  follows: 

(1)  Y  -  Class  motion 

The  purpose  of  the  class  Y  motion  is  to  change  the 
orientation  of  the  space  structure  about  its'  Y^  axis 
using  the  manipulator.  The  manipulator  will  be  at  the 
"home"  configuration  at  the  beginning  and  end  of  this 
motion.  Furthermore,  during  this  motion  the  first  joint  of 
the  manipulator  will  be  kept  fixed  at  =  0*0  radians. 
The  motion  of  the  nicuiipulator  will,  therefore,  remain 
confined  to  the  plane,  and  the  problem  will  reduce 
to  a  pleuiar  problem. 

(2)  Z  -  Class  motion 

The  purpose  of  the  class  Z  motion  is  only  to  reconfigure 
the  manipulator.  It  will  be  used  to  bring  the  manipulator 
to  the  "intermediate"  configuration  from  the  "home" 
configuration,  and  vice  versa.  The  reconfiguration  will 
be  achieved  by  using  only  the  first  joint  of  the 
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manipulator.  The  second  and  third  joints  of  the 
manipulator  will  be  held  fixed  at  ($2'  ^3^  *  (0,0)  during 
this  motion.  The  motion  of  the  manipulator  will, 
therefore,  remain  confined  to  the  Xg-Yg  plane.  Note  that 
the  Z-class  motion  is  a  holonomic  motion  because  only  one 
manipulator  joint  is  involved  in  this  motion. 

(3)  X  -  Class  motion 

The  purpose  of  the  class  X  motion  is  to  change  the 
orientation  of  the  space  structure  about  its'  Xg  eocis 
using  the  manipulator.  The  manipulator  will  be  at  the 
"intermediate"  configuration  at  the  beginning  euid  end  of 
this  motion.  Furthermore,  during  this  motion  the  first 
joint  of  the  memipulator  will  be  kept  fixed  at  »  ir 
radians.  The  motion  of  the  manipulator  will,  therefore, 
remain  confined  to  the  Yg-Zg  plcine. 


To  reorient  the  structure  there  are  twelve  possible 
combinations  of  rotations  about  the  body  fixed  sixes.  The 
scheme  chosen  for  this  problem  was  to  sequentially  rotate  the 
structure  about  its'  y-x-y  axes. 

1.  Y  •  Class  Notloj:i 

The  chemge  in  orientation,  rotation  of  the  structure 
about  its'  Yg  axis  is  given  by  the  nonholonomic  angular 
momentum  constraint  equation  as  follows: 


i  =  (aij  +  bij)  , 


(3 -la) 


a  A  CiSinSj  +  CjCosB,  +  CjSinOj  +  63)  +  Sj  , 
b  A  CjCosOj  +  CjSinCOj  •••  O3)  +  , 

A  A  2CiSin02  C^cosO,  2C^sin(62  +  B,)  -  s,  , 
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where  the  constants  Cj^,  C^,  C^,  s^/  82  and  S3  are  defined  as. 


q  A  1^(0. Sm^  +  iHj)  [ms(r  ♦  i^)  +  O.SqiJ  , 
q  A  +  O.Bin^)  , 

q  A  O.Ssijij  [jUgCr  +  ii)  +  0.5qii]  ,  (3 -lb) 

Si  A  +  (0.25sij  +  -  {0.5in^  +  , 

S3  A  +  0.25in3i3*]  -  Q.2Sn^ll  , 

S3  A  -mtils22  *  A33  ■*■  (^  *  %)  (r  +  0.5li)*] 

-[q(r  +  O.Sii)  ■*■  +  i»^)  (r  +  ij)  -  Sj  , 


and  where,  ^  +  m2  +  m^) ,  and  r,  I2,  I2  and  I3  are 
defined  in  Figure  3.1(b).  Equation  (3 -la)  gives  the  cuigular 
velocity  of  the  structure  about  its'F^  aucis  as  a  function  of 
the  joint  configuration  amd  joint  velocities. 

If  the  second  amd  third  joints  of  the  manipulator  move 
along  a  closed  path  C  in  the  02 ~ ^3  plane,  then  the  net  chamge 
of  orientation  of  the  spacecraft  about  its'  Yg  aucis  is  given 
by; 
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where,  S  is  the  surface  area  enclosed  within  the  closed  curve 
C.  Choosing  the  surface  area  S  to  be  rectangular,  to  simplify 
the  integration,  and  specifying  three  of  the  four  limits  of 
integration  we  Ccui  solve  for  the  chamge  in  orientation  as  a 
function  of  the  fourth  limit  of  integration.  The  fourth,  auid 
unknown,  limit  of  integration  was  chosen  as  ^20*  After 
integrating,  the  final  expression  for  the  change  in 
orientation,  as  a  function  of  62■^^,  Equation  (3-3)  was 
obtained . 


♦y  = 

_^C^cos^  S3  - 2 qsin6;„  - 2 Cacose^^ 

V5  ^  S3-C^“2(C3  +  C3)sin62u  2V5 

2  (S2V5  ♦  (S3  -2qsinej„)  V4]  _ 


arc  tan  (  sine2„-2qcosB2„  ^ 


2  [Sj V5  +  (S3  -2q8ine2„)  vj  j  -2qcose2„ ^ 


-11  f  Ji 

Vj  2 


[^■Kln( 


2^3-53 

q-S3 


)] 


(3 -3a) 


2(S2V2  +  S,v;)  ,  ,2q-q-S3,  ^  ,2C3,, 

+ - =-= — -—i  -  larctan  (  —■■■■— — - )  -arctan  ( — - )  ] 

V2V3  V3  V3 

S3+2S,  -  ^  .  2q- (83+203) tan (02„/2)  /2q.- 

+-^ - i  [arctan (—-^: - 2 - 2 - 22 - )  -arctan ( — 1)  ] 


V7 


V7 


s3+2s3  +  q _ 2(q+q)  +  (q-Sj)  t2ui(82u/2) , 

'  '  '  ■  — •  OX  CUCUl  V  '  1  i— T-  f 


s3+2s,+q  ^  ,2(C3+q). 

__3 - l---iarctan( - ^  ■  ) 
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with 


A  Cj*  +  2C3*  , 

V2  4  +  4C3*  , 

Vj*  4  S3*  -  -  4C3*  ,  (3 -3b) 

4  Vj  +  2C,C3sine3„  , 

v^*  4  (S3  -  2C38in02u)*  -  (C^  +  2C3sin62„)^  -  4C3*cos*62u  / 

V,*  4  S3*  -  4C3*  -  4C3*  , 

Vg*  4  (Cj  -  S3)*  -  4(q  +  C3)*  . 

The  relationship  of  escpressed  as  a  continuous  fimction  of 
Equation  (3-3),  for  0  s  ^2u  *  ir  is  shown  in  Figure  3.4. 

Since  the  joints  of  the  meuiipulator  will  have  physical 
limits,  the  maximum  absolute  value  of  t^y  will  be  limited  by 
the  maximum  value  of  $2u'  Referring  to  Figure  3.4,  if  we 
in^ose  the  joint  limit  of  92u  *  (3ir/4)  radiams,  then  the 
maximum  chamge  in  4>y  will  be  of  the  order  of  *7.50  degrees. 
Note  that  the  sign  of  ^y  can  be  reversed  by  singly  traversing 
the  closed  path  in  the  02“ ^3  pisne  in  the  opposite  direction. 
If  a  change  in  orientation  greater  tham  ^y  >  7.5  degrees  is 
desired,  then  the  mamipulator  joints  will  have  to  move  along 
some  closed  path  a  multiple  nusdser  of  times.  This  closed  path 
cam  be  foxind  as  follows:  Set  the  desired  chamge  in  ^y  to  Q 
where  Q  -  dn,  fi  denotes  the  chamge  in  orientation  each  time 
the  mamipulator  traces  out  a  path,  n  denotes  the  integer 
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number  of  times  the  arm  must  trace  the  path.  The  integer  n  is 
then  obtained  by  mcocimizing 

6  »  Q/n  s  7.50 

The  value  of  flju  then  obtained  from  Equation  (3-3)  by 
setting  By»6  and  using  a  non- liner  function  solver  to  solve 
for  the  root  of  Equation  (3-3)  .  Visual  examination  of  Figure 
3.4  will  give  the  range  in  which  the  root  of  the  function  will 
lie. 

Hence,  any  changes  in  orientation  of  the  space 
structure  about  its'  Yq  eucis  can  be  achieved  through  a  single 
or  multiple  closed  looped  trajectories  of  class  Y  motion. 

2.  Z  -  Class  notion 

The  purpose  of  class  Z  motion  is  solely  to  reconfigure 
the  manipulator  from  the  "home"  configuration  to  the 
"intermediate"  configuration  and  vice  versa.  This  motion 
makes  it  possible  to  change  from  rotating  the  structure  about 
its'  Yg  eocis  to  rotating  the  structure  cd70ut  its'  Xg  eucis  amd 
vice  versa.  This  will  allow  the  y-x-y  rotation  sequence 
previously  discussed. 

The  chcuage  in  the  orientation  of  the  structure  about 
its'  Zg  axis  is  given  by  the  holonomic  Equation  (3-4)  . 

3 

Is33^z  *  *  0.25il^V  ♦  iB,<0.5J3  +  1^)2]  *  ^g)  -  0  ,  (3-4) 
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which  upon  integration  yields, 


♦z  -  .  )■;  . 


Ig23  *  Iff  2 


(3-5) 


^  ^  ^i22  ^  0  .25/i^2j^  +  ■ 


The  chcuige  in  orientation  is  negative  when  the  manipulator 
moves  from  the  "home"  configuration  to  the  "intermediate" 
configuration.  It  is  positive  when  the  meuiipulator  moves  from 
the  "intermediate"  to  the  "home"  configuration.  The  cdssolute 
value  of  4>g  is,  therefore,  a  constant  whose  value  depends  upon 
the  inertia  parameters  of  the  system. 

3.  X  •  Class  Motion 

The  change  in  orientation  of  the  structure  about  its' 
Xg  eucis  is  confuted  in  a  similar  fashion  as  that  for  the 
motion  edsout  the  Yg  axis.  All  the  ec[uations  developed  for  the 
Yg  class  motion  will  hold,  however,  with  three  changes,  0^  is 
replaced  by  the  constant  Sj  in  Equation  (3 -la)  will  have 
Jg22  ^replaced  with  Ign,  cuid  A  in  Equation  (3 -la)  will  be 
replaced  by  -A.  denoting  the  change  in  orientation  of  the 
structure  about  its'  Xg  axis  can  be  esqpressed  as  a  continuous 
function  of  $2^31  for  0  s  dju  *  shown  in  Figure  3.4. 
Again  imposing  the  limitation  of  $2^  s  (3ir)/4  radieuis,  the 
meocimum  chamge  in  4>x  vill  be  of  the  order  s  6.66  degrees. 
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Using  the  same  logic  as  for  (py,  we  can  conclude  that 
any  arbitrary  change  in  the  orientation  of  the  space  structure 
about  its'  Xg  axis  can  be  achieved. 

C.  SYNTHESIS  OF  MANIPULATOR  MOTION  FOR  REORIENTATION 

Having  looked  at  how  the  orientation  of  the  space 
structure  changes  with  motion  of  the  manipulator,  the  goal  now 
is  to  determine  the  path  necessary  for  the  manipulator  to 
traverse,  so  that  we  may  achieve  the  desired  change  in  the 
orientation  of  the  structure.  As  previously  discussed,  in 
section  B,  we  have  chosen  an  y-x-y  scheme  to  reorient  the 
space  structure.  To  do  this,  consider  the  following  sequence 
of  five  rotations  where  the  change  in  orientation  of  the 
structure  about  the  X^,  Yg,  and  Zg  axes  are  denoted  by  A^,  A2, 
A^ !  and  A^ . 

1.  Class  Y  motion  with  <t>y  ■  A^ 

2.  Class  Z  motion  with  <t>g  »  A2 

3.  Class  X  motion  with  «  A3 

4.  Class  Z  motion  with  ^  ~^2 

5.  Class  Y  motion  with  4>y  »  A4 

Note  that  A^,  A3,  euid  A4  are  variables;  whereas,  A2  has  a 
constant  cQssolute  value.  This  is  because,  as  previously 
noted,  the  sole  purpose  of  the  Z  class  motion  is  to 
reconfigure  the  manipulator  arm. 

Looking  at  this  sequence  of  rotations  in  detail:  Let  the 
initial  orientation  euid  the  desired  orientation  of  the  space 
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structure  with  respect  to  the  inertial  frame  be  given  by  the 
rotation  matrices  and  R^,  respectively.  Then, 


Rl  &  J2[y/03i]  (3 -6a) 

Rf  &  [y*  ^3f ] -R  [-X,  ^2f ] ly/ ]  (3  “6b) 

where  (0ii» 02i» (^if denote  the  set  of  Euler 
angles  describing  the  initial  and  the  desired  orientation  of 
the  space  structure  with  respect  to  the  inertial  frame.  Then, 
the  set  of  y-x-y  Euler  angles  (0i,02'^3^  describing  the 
desired  orientation  of  the  space  structure  with  respect  to  the 
initial  orientation  can  be  solved  from  the  following  equation. 

Rly.<t>2^R[x,<l>2]Riy.<l>i]  =  RfRi"^  (3-7) 

Equation  (3-7)  has  a  singularity  for  (f>2  »  0,  ±7r,  .  Except  for 
this  situation,  ^3^,  <(>2  and  ^3  can  be  solved  uniquely  from 
Equation  (3-7).  At  the  singular  configuration (s) ,  the 
orientation  of  the  structure  can  be  trivially  depicted  by  one 
single  rotation  about  the  Yg  axis  of  magnitude  {4>^  +  ^3)  for 
02  ”  0,  and  of  magnitude  (<t>^  -  ^3)  for  02  *  ± 

Consider  the  sequence  of  rotation  of  the  manipulator; 

1.  Class  Y  motion  with  0^  «  A^.  The  change  in  the 
orientation  of  the  structure  can  be  represented  by 
■Kty/-^i]  •  At  the  end  of  this  motion  the  manipulator 
returns  to  the  "home"  configuration. 

2.  Class  Z  motion  with  0^  =  A2.  A2  is  obtained  from 
Equation  ( 3 - 5 )  as : 
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(3-8) 


A,  = 


-( - 

Ih  *  2 


The  change  in  the  orientation  of  the  structure  can  be 
represented  by  .  By  virtue  of  this  motion,  the 

manipulator  moves  from  the  "home"  configuration  to  the 
"intermediate"  configuration. 

3.  Class  X  motion  with  «  A3.  The  change  in  the 
orientation  of  the  space  structure  can  be  represented  by 
I?[x,A3}  .  At  the  end  of  this  motion  the  manipulator 
returns  to  the  "intermediate"  configuration. 


4.  Class  Z  motion  with  ~  *  ^2,  where  A2  is  defined  by 
Equation  (3-8)  .  The  chcinge  in  the  orientation  of  the 
structure  can  be  represented  by  12[z, -Aj]  .  By  virtue  of 
this  motion,  the  manipulator  moves  from  the 
"intermediate"  to  the  "home"  configuration. 


5.  Class  Y  motion  with  *  A^.  The  chemge  in  the 
orientation  of  the  structure  can  be  represented  by 
E[y,A4]  .  At  the  end  of  this  motion  the  manipulator 
returns  to  the  "home"  configuration. 


If  the  manipulator  goes  through  the  sequence  of  motions 
discussed  eUaove,  the  change  in  the  orientation  of  the  space 
structure  would  be  represented  by  the  rotation  matrix. 


Rly,A^]R[z,  -A3I  J?[x,A3li?[z,A2]i?[y,Ai]  (3-9) 


If  euiy  arbitrary  chemge  in  the  orientation  of  the  space 
structure  given  by  Equation  (3-7)  is  to  be  attained  through 
the  cdxsve  sequence  of  motions,  then  we  should  be  6d>le  to  solve 
for  A3,  A3,  and  A4  from  the  following  equation; 
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(3-10) 


Riy,f^i\R[z,  -Aj] JZ[jc,A3]J?(2,A2]  = 

R  iy,  ♦a  ]  [x,  4>j  ]  J?  [y , 

for  arbitrary  values  of  and  ^3.  Equation  (3-10)  will 

have  a  singularity  for  ^2  «  0,  tr.  Then  Equation  (3-10)  cam 
be  solved  by  setting  A2  ■  A3  «  A4  «  0,  and  equating  A^  »  (0^ 
+  ^3)  when  i>2  *  and  A^  »  (^^  -  ^3)  when  ^3  “  When  ^2  ^ 

0,  ±ir,  we  solve  for  Aj^,  A3,  amd  A4  by  first  rewriting  Equation 
(3-10)  as: 

R[z,-h^]R[x,LAMxA^]R[z,K^]  =  E[y,^3-A4]E[x,^2]2?[y,^i-Ail  (3-11) 

02  ^  0,  ±ir 

The  product  of  the  matrices  on  both  sides  of  Equation  (3-11) 
is  in  a  direction  cosine  matrix  that  cam  be  equivalently 
represented  by  the  set  of  four  euler  parauneters  /?i,  182' 
amd  184  [Ref.  10]  as  follows: 

Po  =  cos(-^),  Po  =  cos(-^)cos(  ^-)  (3-12) 

A  AW 

P3  =  sin(-^)cosA2  ,  Pi  *  sin ( -^ ) cos (  ^^  (3-13) 

A  A  A 

P2  -  sin(-~)sinA2  ,  P2  =  cos ( •% ) sin ( )  (3-14) 

2  2  2 

P.  -0,  S3  -  sin(.fe)Bln(t^~*«~*i*'*i)  ,3.jL5, 
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Since  0,  ±v,  Equations  (3-12)  through  (3-15)  can  be 

solved  for  A^,  A3,  and  A4  as  follows: 

Aj  =  ~  arctauitsinAj  tan(A3/2)]  ,  (3-16) 

A3  =  2arcsin(sin(<|>2/2)  secAjl  /  (3-17) 

A4  «  Aj  +  <|>3  -  .  (3-18) 

The  algorithm  for  the  reorientation  of  the  space  structure 
can,  therefore,  be  established  as  follows:  First  solve  for 
the  necessary  change  in  the  orientation  ^2'  ^3 

Equation  (3-7)  .  Next  confute  the  values  of  A^,  A3,  and  A4 
from  Equations  (3-16)  through  (3-18)  using  the  connputed  values 
of  4>2  and  03.  For  each  of  A,^,  A3  cuid  A4,  confute  the 
closed  trajectory  in  the  62' ^3  ^Ae  number  of  times 

that  the  nanipulator  has  to  traverse  the  closed  trajectory. 
Such  trajectories  Ceui  always  be  plaxmed.  Now  that  the 
trajectories  are  )cnown  we  can  follow  the  five  step  motion 
sequence  to  achieve  the  desired  chemge  in  orientation  of  the 
structure. 

D.  SZKDLATXON  BBSULTS 

A  simulation  was  conducted  for  a  large  angle  mauieuver  of 
an  arbitrairy  space  structure  where  the  manipulator  had  the 
following  Jcinematic  parameters,  according  to  Figure  3.1b 


32 


r  = 


0.35  w,  I2 


0.40  m 


0.15  m,  Ij  = 


=  0.50  in,  Ij  = 


The  dynamic  parameters  used  are  given  in  Table  3.1.  The 
initial  and  desired  orientations  of  the  space  structure,  given 
in  degrees  were: 


®  (135.0,25.0,-105.0)  (3-19) 


=  (-55.0,95.0,75.0)  (3-20) 


This  yielded  the  following  y-x-y  Euler  angles: 

Aj  =  -66.79483, 

Aj  =  -11.09346,  (3-21) 

A3  =  123.43739, 

A^  »  89.83769 

From  the  orientation  and  Euler  angles,  Aj^,  ^3  -^4 

obtained  as  follows: 


(♦i/*2'^3>  *  (-86.47308,113.57773,70.15945)  (3-22) 

where  the  xinits  are  in  degrees. 

The  orientation  of  the  structure  at  the  beginning  and  the 
end  of  each  of  the  five  sequences  of  rotations  is  as  shown  in 
Figure  3.5.  The  description  of  the  closed  loop  path  in  the 
(9i-02'®3  space  is  as  shown  in  Figure  3.6.  As  the  manipulator 
traces  out  the  path,  as  described  in  Figure  3.6,  the  evolution 


33 


of  the  Euler  angles  with  respect  to  time  is  illustrated  in 
Figure  3.7. 


1.  Class  y  motion  with  =  -66.79483  degrees.  The  minimum 
number  of  times  the  robot  has  to  move  along  a  closed 
trajectory  will  be  n  =  9.  Then,  for  each  closed  loop 
motion  the  change  in  orientation  needs  to  be  -66.79483/9 
=  -7.42164  degrees  from  Figure  3.4,  we  find  that  <t>y  = 
+7.42164  degrees  corresponds  to  a  value  of  ^2u  that  lies 
between  125.0  and  135.0  degrees.  Using  these  values  as 
the  lower  and  upper  limits,  we  find  the  exact  solution 
for  4>y  -  7.42164  in  Elation  (3-3)  to  be  133.84235 

degre^.  The  negative  sign  in  the  change  in  orientation 
can  be  taken  care  of  by  simply  travelling  along  the 
closed  path  in  the  negative  direction. 


In  Figure  3.6  ABCDA  denotes  the  directed  closed  path  in 
the  6^-62  plane.  The  change  in  the  y-x-y  Euler  angles 
$2'  ^3^  shown  in  Figure  3.7  during  the  time  t  = 
0  seconds  to  t  =  483.92  seconds.  It  can  be  seen  from 
Figure  3 . 7  that  during  this  time  and  <t>2  remain 
constant,  whereas  4)^  changes  with  a  periodic  motion.  The 
number  of  periods  is  equal  to  nine  and  corresponds  to 
the  number  of  times  the  second  and  third  joints  of  the 
robot  move  along  the  closed  path  ABCDA  in  Figure  3.6. 
The  configuration  of  the  system  at  the  start  and  finish 
of  this  motion  is  shown  in  Figure  3.5(a)  and(b) . 


2.  Class  Z  motion  with  A2  »  -11.09346  degrees.  In  Figure 
3.6,  the  path  segment  AO  corresponds  to  the  motion.  The 
variation  of  the  y-x-y  Euler  angles  during  this  motion 
are  not  very  clear  from  Figure  3.7  because  this  motion 
takes  only  10  seconds  to  complete,  as  compared  to  the 
total  time  of  simulation  which  is  of  the  order  of  2166 
seconds.  Figure  3.5(b)  and  (c)  show  us  the  configuration 
of  the  system  at  the  beginning  and  the  end  of  this 
motion. 


3.  Class  X  motion  with  A3  =  123.43739  degrees.  The  minimum 
number  of  times  the  robot  has  to  move  along  a  closed 
trajectory  will  be  n  «  19.  Therefore,  for  each  closed 
loop  motion  the  change  in  the  orientation  needs  to  be 
123.43739/19  -  6.49670  degrees.  From  Figure  3.4,  we  find 
that  <P-  -  -6.49670  degrees  corresponds  to  a  value  of  62^ 
that  lies  between  125.0  and  135.0  degrees.  Using  these 
values  as  the  lower  and  upper  limits  we  find  the  exact 
solution  for  <f>y^  -  -6.49670  to  be  132.19918  degrees. 
Since  travelling  along  the  positive  direction  of  the 
closed  path  produces  a  negative  change  in  the  orientation 
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as  evident  from  Figure  3.4,  we  will  travel  in  the 
negative  direction.  In  Figure  3.6,  OPQRO  denotes  the 
directed  closed  loop  path  in  the  9 2' ^2  pla^ne.  The  change 
ih'the  y-x-y  Euler  angles  4>2i  ^3)  is  shown  in  Figure 

3.7  during  the  time  t  =  493.92  seconds  to  t  =  1509.27 
seconds.  It  can  be  seen  from  the  figure  that  all  the 
Euler  angles  undergo  a  periodic  motion  during  this  time. 
The  ntimber  of  periods  can  be  seen  to  be  equal  to  nineteen 
and  equals  the  number  of  times  the  second  and  third 
joints  of  the  robot  move  along  the  closed  path  OPQRO  in 
Figure  3.6.  The  configuration  of  the  system  at  the  start 
and  finish  of  this  motion  is  shown  in  Figure  3.5(c)  and 
(d)  . 

4.  Class  Z  motion  with  A2  =  11.09346  degrees.  In  Figure 
3.6,  the  path  segment  OA  corresponds  to  this  motion.  The 
variation  of  the  y-x-y  Euler  angles  during  this  motion 
are  not  very  clear  from  Figure  3.7  because  this  motion 
takes  only  10  seconds  to  conplete,  as  compared  to  the 
total  simulation  time  which  is  of  the  order  of  2166 
seconds.  Figure  3.5(d)  and  (e)  show  us  the  configuration 
of  the  system  at  the  beginning  and  end  of  this  motion. 

5.  Class  Y  motion  with  =  89.83769  degrees.  The  minimum 
nvimber  of  times  the  robot  has  to  move  along  a  closed 
trajectory  will  be  n  >=  12.  Then,  for  each  closed  loop 
motion  the  change  in  the  orientation  needs  to  be 
89.83769/12  »  7.48647  degrees.  From  Figure  3.4,  we  find 
that  <t>y  -  7.48647  degrees  corresponds  to  a  value  of  $2^ 
that  lies  between  125.0  euid  135.0  degrees.  Using  these 
values  as  lower  emd  upper  limits,  we  find  the  exact 
solution  for  =  7.48647  in  Equation  (3-3)  to  be 
134.73799  degrees.  In  Figure  3.6,  AMNBA  denotes  the 
directed  closed  loop  path  in  the  ^2 "^3  plane.  The  change 
in  the  y-x-y  Euler  angles  {4>x,  02'  ^3^  shown  in  Figure 
3.7  during  the  time  t  -  1519.27  seconds  to  t  =  2166.64 
seconds.  It  can  be  seen  from  the  figure  that  during  this 
time  the  Euler  cuigles  0^  and  02  remain  constant  whereas 
03  chcuiges  with  a  periodic  motion.  The  ntunber  of  periods 
can  be  seen  to  be  equal  to  twelve  and  it  equals  the 
number  of  times  the  second  and  third  joints  of  the  robot 
move  along  the  closed  path  AMNBA  in  Figure  3.6.  The 
configuration  of  the  system  at  the  start  and  finish  of 
this  motion  is  shown  in  Figure  3.5(e)  and  (f ) . 

We  have  thus  effectively  demonstrated  a  new  method  for 
attitude  control  of  a  freely- floating  space  structure  via  a 
surface  integral  approach.  The  next  chapter  will  address  the 
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Figure  3.1(a) :  The  Home  Configuration  of  the  Three  Link  Robot 
Manipulator  Mounted  on  the  Space  Structure  is 
Shown.  The  Link  Frames  are  J^ccording  to  the 
Denavit - Hartenburg  Convention . 


Figure  3.1(b):  Kinematic  Structure  of  the  3 -Link  Robot 
Manipulator  with  Revolute  Joints .  The  Home 
Configuration  of  the  Itemipulator  is  Shown. 
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Satellite  Configurations  (a 
Configuration  with 
Intermediate  Configuration  with 


^2u  (deg) 


Figure  3.4:  For  the  Simulation  in  Section  D,  the  Cheuige  in 

the  Orientation  of  the  Space  Structure  about 
its  X  and  y  cuces:  emd  ^  respectively. 
Depends  Upon  the  Dimension  of  the  Rectangular 
Path  in  the  Plane. 
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TABLE  3.1:  DTNMIZC  PARAMETERS  OP  THE  3-R  MANIPULATOR 

Ikij  (kg-a^). 


k-S 

H 

■ 

M 

k>2 

k-3 

(1,1) 

23.95781 

00.0830 

00.0147 

00.0117 

(2,2) 

13.87031 

00.0103 

00.2343 

00.1221 

(3,3) 

37.82812 

00.0830 

00.2343 

00.1221 

_ 

302.6250 

7.62615 

10.8945 

mmm 

'4, 


42 


Flgur*  3.€t  Description  of  the  Closed  Loop  Path  in 

Space  that  Changes  the  Orientation  of  the 
Space  Structure  from  an  Initial  y*x-y  Euler 
Jingles  of  (135.0,  25.0,  -105.0)  Degrees  to  a 
Final  Value  of  (-55.0-95.0,  75.0)  Degrees. 


43 


4»Z.  03  (deg) 


Flgnr* 


3.7;  Evolution  of  the  Euler  Angles  0^^,  02,  03 

Describing  the  Orientation  of  the  Space 
Structiire,  for  the  Simulation  in  Section  D. 


IV.  "  PLANNING  REPEATABLE  PATHS  FOR  PLANAR  SPACE  ROBOTS 

A.  INTRODUCTION 

In  Chapters  I  and  III,  we  saw  that  due  to  the  nonholonomic 
nature  of  a  freely- floating  space  structure  the  use  of  an 
organic  manipulator  will  result  in  a  change  in  the  orientation 
of  the  structure.  Automation  in  space  requires  the  ability 
for  a  space  robot  to  perform  a  task  repeatedly  in  its  work 
space  without  any  drift  in  its  configuration  variables,  i.e., 
joint  angles,  orientation,  and  end- effector  position.  Hence, 
the  resultant  change  in  orientation  of  the  structure  as  the 
manipulator  arm  performs  a  required  task,  which  we  exploited 
in  Chapter  III  for  attitude  control,  is  undesirable  for 
automation. 

In  Chapter  II  we  proposed;  (1)  that  integrability  of  the 
differential  constraint  is  only  a  sufficient  condition  for 
repeatability,  but  it  is  by  no  mecuis  a  necessary  condition, 
emd  (2)  that  a  necessary  condition  for  repeatable  motion  was 
that  the  fiinction  F  defined  by  Equation  (2-10)  be  equal  to 
zero. 

This  chapter  will  apply  these  ideas  to  a  two  dimensional 
space  robot.  The  two  dimensional  case  is  studied  purely  for 
its  simplicity. 
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B.  NECESSARY  CONDITION  FOR  REPEATABILITY 


Not  all  nonholonomic  systems  exhibit  pseudo -holonomic 
behavior.  Consider  the  rolling  disk  shown  in  Figure  4.1  [Ref. 
8] .  The  two  nonholonomic  constraints  are  given  by: 

dx  -  r  sina  d(9  (4 -la) 
dy  -  r  cosot  dO  (4 -lb) 

Rearranging  Equation (4-1)  for  the  change  in  the  dependent 
variables  x  and  y  for  the  closed  loop  motion  of  the 
independent  variables  $  and  a  we  get: 

f  dx  -  {  r  sina  d0  (4-2a) 
I  dy  »  J  r  cosa  d9  (4 -2b) 

where  F(a,9)  a  {  sina,  cosa  }.  Since  F(a,0)  will  not  equal 
zero  at  euiy  point  in  the  space  of  6  and  a  it  will  not  satisfy 
the  condition  for  repeatability,  consec[uently  it  does  not 
admit  repeatable  motion. 

In  the  case  of  a  planar  space  robot  with  two  links,  shown 
in  Figure  4.2,  the  nonholonomic  conservation  of  momentum 
constraint  equation  is  given  by  Equation (4-3) . 


^  ^  (4-3) 

“  (Bj,  ©2)  ®2^  ^®2 
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where 


0Q  -  the  orientation  of  the  space  vehicle, 

and  $2  *  the  joint  variables  of  the  manipulator, 

A,  B,  C  *  functions  of  6^  aind  $2  as  defined  in  Appendix  A, 

r  »  the  position  of  the  joint  of  the  first  link  with 
respect  to  the  center  of  gravity  of  the  body, 

*  the  length  of  the  first  link, 

J  »  the  length  of  the  second  link, 

m2  are  the  masses  of  the  rigid  body  and  the  two 

links, 

Iq,  1^,  I2  are  the  moments  of  inertia  of  the  rigid  body 
and  the  two  links  cd>out  their  respective  centers  of  mass, 

M  ^  niQ  +  Ml  +  m2  ,  cuid 

•  Iq  +  +  I2  . 

Applying  Stoke 's  theorem  to  Equation  (4-3)  we  get 


=  ff 

Jjs 


(4-4) 


where  S  is  the  region  enclosed  by  the  path  C  in  the  joint 
space  of  the  robot  which  the  meuiipulator  arm  traces.  We  Cem 
show  that  A  0  therefore  Equation  (4-4)  will  satisfy  the 
necessary  condition  for  repeateUbility  if; 


^(01, 62)  A  [A 


86 


=  0 


(4-5) 


47 


where  9^  0 . 

To  find  the  "holonomic  loop",  on  which  the  planar  space 
robot  exhibits  holonomic  behavior  globally,  we  need  find  the 
values  of  6^  auid  $2  which  set  Equation  (4-5)  to  zero.  To 
determine  the  appropriate  values  of  6^  and  62  •  choose  path 
in  the  robot  joint  space,  which  we  desire  the  robot  to 
execute,  such  that  it  encloses  at  least  one  point  where  the 
function  F  goes  to  zero.  This  path  can  then  be  optimized  by 
using  a  variety  of  niomerical  optimization  techniques  to  drive 
Equation  (4-5)  to  zero.  In  simulation  we  choose  to  use  (1)  an 
elliptical  path  as  the  most  general  case  of  a  path;  and,  (2) 
the  steepest  descent  optimization  technique  for  its 
sin^licity. 

The  elliptical  path,  shown  in  Figure  4.3,  was 
parameterized  as  follows: 

"  ®io  *  ^  COS0  cos27rt  -  b  sin0  sin27rt,  t  e  [0,1]  (4-6a) 
^2  "  ^20  ^  sin^  cos27rt  +  b  cos^  sin2Trt,  t  €  [0,1]  {4-6b) 

where  a  and  b  are  the  semi -major  and  semi -minor  axes  of  the 
ellipse  respectively,  4>  is  the  angle  of  inclination  of  the 
ellipse  with  the  6^  cocis,  and  620  a^re  the  coordinates  of 
the  center  of  the  ellipse.  Substituting  Equation  (4-6)  and 
its  time  derivatives  into  Equation  (4-4)  ,  d$  can  be  expressed 
as  a  function  of  the  single  variable  t  such  that  we  get: 
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J  d^O  *  1  +  92^1^2) 

=  I  [gi^i  +  92^2^ 

To  optimize  the  path  we  need  to:  (1)  arbitrarily  choose 
the  parameters,  ^j^q,  djo'  ^  ellipse;  and, 
(2)  to  change  the  five  parameters  so  that  the  value  of  the 
surface  integral  given  by  Equation  (4-7)  is  equal  to  zero. 

In  making  the  initial  choices  of  the  ellipse  parameters, 
we  needed  to  ensure  that:  (1)  the  ellipse  enconpasses  at  least 
one  point  where  the  function  F  defined  by  Equation  (2-10)  is 
equal  to  zero.  This  cam  be  satisfied  by  considering  Figure 
4.4,  which  provides  the  set  of  all  points  where  the  function 
F  vanishes;  and,  (2)  the  elliptical  path  lies  in  the  work 
space  of  the  robot.  This  can  be  done  by  applying  the  methods 
discussed  in  [Ref.  23] . 

For  the  optimization,  to  eliminate  the  trivial  solution, 
where  the  surface  integral  is  zero,  because  the  area  of  the 
closed  path  is  ec[ual  to  zero,  we  inqposed  the  restriction  that 
the  area  of  the  ellipse  was  constant.  In  other  words,  a  and 
b  were  not  allowed  to  change  independently  of  each  other. 
This  imposed  the  added  constraint, 

a  db  -i-  b  da  -  0  (4-8) 
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We  define  a  function  V  as  follows: 


V‘  C  .  C  A  f  F(0i,e2)d0iflB2 

and  solve  the  unconstrained  minimization  problem  by  In^llcltly 
assuming  that  a  amd  b  are  dependent. 

The  steepest  descent  method  Involved  numerical  partial 
differentiation  to  change  the  parameters  of  the  ellipse  auid  to 
solve  the  unconstrained  minimization  problem  where; 


' 

(4 -10a) 

' 

(4 -10b) 

(4-lOc) 

(4-lOd) 

This  provided  a  systematic  way  to  reach  the  local  minimum 
value  of  the  fxmctlon  V.  If  this  minimum  value  Is  zero,  then 
we  have  found  the  "holonomic  loop".  Though  In  general,  the 
method  of  steepest  descent  does  not  guarantee  the  convergence 
of  a  function  to  its  global  minimum  value.  In  our  case  the 
method  always  converged  to  a  minimum.  This  was  due  to  the 
particular  nature  of  the  fimction  F. 
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C.  SnCDLXTION  RESULTS 

A  simulation  was  conducted  for  a  planar  space  robot  which 
had  the  kinematic  and  dynamic  parameters  given  in  Table  4.1. 
The  initial  parameters  of  the  ellipse  were  chosen  to  be: 

a=l. 50000,  b=l. 00000, 

0.75000, 

^10=0-50000,  ^20=0-50000 

The  initial  and  optimal  path  parameters  yielded  the  paths  as 
shown  in  Figure  4.5.  Path  I  and  II  correspond  to  the  initial 
and  optimized  path  paraimeters,  respectively.  Path  I  yielded 
the  niunerical  value  for  Equation  (4-9)  of  =  -0.162775.  The 
optimized  path  parameters  were; 

a«l. 31117,  b=l. 14381, 

4>-0. 79302, 

010=0-34094,  02O=’O-O7O54 

yielding  f  =  -9.9636  *  10*^.  Note  that  the  sinusoidal  curve, 
F{0i,02)  *  0,  inset  in  Figure  4.5  passes  through  both  Paths  I 
and  II,  therefore,  both  paths  satisfy  the  necessary  condition 
for  repeateOaility.  Several  simulations  were  carried  out  and 
in  all  cases  the  "holonomic  loops"  were  found. 

By  finding  the  "holonomic  loop",  control  of  the  attitude 
and,  hence,  the  end-effector  of  the  manipulator  was  obtained. 
The  drift  in  the  end- effector  of  the  manipulator  for  the 
original  path  and  optimized  path  are  given  in  Figures  4.6  and 
4.7,  respectively.  The  magnitude  of  the  drift  in  the  case  of 
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Path  I  is  76.96  mm/ cycle.  The  magnitude  of  the  drift  in  the 
case  of  Path  II  is  negligible  at  0.87  mm/ cycle. 
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Figure  4. It  A  Rolling  Disk  on  a  Flat  Surface. 


53 


Space  Vehicle 


A  Planar  Space  Robot  with  Two  Links  is 
CapeQ>le  of  Exhibiting  Pseudo -holonooiic 
Behavior. 


TABLE  4. It  KIMEKATIC  AED  DYKAMIC  PARAMETERS 


Mass 

Inertia 

Length 

ikgfi 

(Jtg-rf) 

(jb) 

Vehicle 

27.440 

1.520 

r  >  0.20 

Llnk-1 

5.380 

0.115 

li  -  0.50 

Link’ 2 

2.640 

0.028 

Jg  «  0.35 

57 


^2  (rad) 


5 1  (rad) 


Figura  4.5  Elliptical  Paths  in  Joint  Space. 
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y  coordinate  of  end-effector  (m) 


y  coordinate  of  end-effector  (n») 


V.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

This  thesis  has  presented  two  concepts.  The  first  being 
a  algorithm  for  the  motion  planning  of  a  space  manipulator  to 
achieve  attitude  control  of  a  freely- floating  three 
dimensional  space  structure.  Generally  stated  the  algorithm 
provided  a  meauis  for  calculating  the  coordinate  trajectories 
required  to  drive  a  nonholonomic  system  from  one  point  in  its 
configuration  space  to  some  other  desired  point.  The 
algorithm  invoked  Stokes'  Theorem  and  hence  took  a  surface 
integral  approach  to  the  motion  planning  problem.  In 
particular,  we  considered  a  three  dimensional  structure  with 
a  three  link  manipulator  arm. 

Due  to  the  nonholonomic  nature  of  structures  in  space, 
articulated  joint  manipulators  can  effectively  be  used  as  a 
back-up  means  to  a  gyroscope  for  the  attitude  control  of  these 
structures.  Attitude  control  is  achieved  through  the  motion 
planning  of  the  internal  motion  of  the  manipulator  arm  joints. 
We  found  the  surface  integral  approach  to  be  a  single  and 
effective  means  to  solving  the  motion  pleuining  problem. 

Secondly,  we  presented  a  means  of  determining  the 
manipulator  motion  required  for  the  nonholonomic  freely- 
floating  space  structure  to  behave  in  a  holoncmiic  manner. 
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which  we  called  "pseudo-holonomic" .  Our  method  determined  if 
"holonomic  loops"  existed,  where  the  system  exhibits  holonomic 
behavior  globally  for  the  configuration  space  of  the 
nonholonomic  system.  If  a  "holonomic  loop"  did  exist  we 
presented  an  algorithm  for  finding  that  loop  within  the 
configuration  space.  In  this  case,  we  looked  at  a  planar 
space  robot  with  a  two  link  manipulator  arm. 

Additionally,  though  the  nonholonomic  nature  of  the  space 
structure  does  not  normally  admit  repeatable  motion,  it  is 
possible,  however,  to  find  exceptions  to  the  rule  where 
systems  do  exhibit  holonomic  behavior  globally.  Finding  the 
"holonomic  loop"  in  the  joint  space  of  the  manipulator 
admitted  repeatc±»le  motion  of  the  space  robot.  Hence,  we  have 
seen,  that  manipulators  can  effectively  serve  the  dual  purpose 
of  attitude  control  and  automation  in  space. 

We  have  demonstrated  the  ability  to  predict  and  control 
the  change  in  orientation  of  a  freely- floating  space 
st3mcture. 

B.  RECOMMENDATIONS 

The  application  of  the  two  algorithms  to  more  conplicated 
structures  is  the  next  logical  step.  The  approach  presented 
here  can  be  extended  to  other  nonholonomic  systems  such  as 
mobile  robots-  The  finding  of  "holonomic  loops"  can  be 
further  extended  to  the  three  dimensional  space  structure  with 
eui  attached  three  linked  manipulator  arm. 
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APPENDIX  A 


The  terms  A,  B,  and  C  in  Ec(.(2)  are  deBned  as  tbllows 


-4  *  /t  +•  •r7>'*'no(rni  +  »nj)  +  r77(»aon»i  +  mitni  +4mo>»n)  +  +  fni) 

ivi  4iW  4«V/ 

+  77mo(mi  +  2mi)rlico$  0i  +  — m}(mo  +0.Smi)^/3COjd2  +  -^mom^r/jcoaCfli  +0^) 
M  M  M 


&  2 
B  —  Ii+  li’h  --—(momi  +  mim-i  +  mo/nj)  +  T77”»a(»no  +  +  T7'’'o(”»i  +2m2)rlicos0i 

4A'/  4Aj  aW 

+  — mj(mo  +0.5fin)ii/2COji5*i  +  :r77momQr/*2Co«{di  +  O^) 

Ai  2M 


C  —  [-i  +  4-  +  ^^"«o'»‘a^Wacojt02  +  ^j^inctnirl2cos{0i  +  O-^) 


wliere,  mo.  mt,  and  m-j  are  the  masses  of  the  space  vehicle  and  the  two  links  of  the  ma¬ 
nipulator,  /o,  h,  and  h  are  the  moment  of  inertias  of  the  space  vehicle  and  the  two  links 
about  their  center  of  masses,  r  is  the  distance  of  the  first  joint  from  the  center  of  mass  of 
the  vehicle,  Ij  anti  I3  are  the  lengths  of  the  two  links,  M  *  mo+mi  -t-mj,  and  f,  *  /o  +  /i  4-/j. 
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